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INTRODUCTION 


This  report  defines  the  reference  coordinate  frames  and  provides  the 
dynamic  equations  required  to  support  development  of  autopilot  initialization  j 

algorithms  in  the  fire  control  computer  for  the  Vertical  Launch  ASROC  system. 

The  report  presents  a  mathematical  definition  of  the  dynamic  data  required  by 
the  missile  autopilot  for  prelaunch  initialization.  These  include: 

i 

( 1 )  Attitude  of  the  command  reference  frame  relative  to  the  autopilot 
reference  frame 

(2)  Velocity  of  the  launch  point  reference  relative  to  the  moving  air 
mass 
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NOTATION  FOR  VECTORS  AND  ORTHOGONAL  TRANSFORMATIONS 


We  understand  that  r  represents  a  vector  quantity  without  reference  to 
any  particular  coordinate  frame •  If  we  wish  to  specify  the  vector  r  expressed 
in  terms  of  x^y^z^  coordinates,  we  use  r^. 


The  orthogonal  transformation  A^  represents  the  transformation  from  the 
x  y  z  coordinate  frame  to  the  x  y,z  frame*  Thus: 

111  J  J  J 


xj  -  Aijxi 


(1) 


The  inverse  transformation  (from  Xj^j2j  to  xiyiZj^  ^  indicated  by 
A^  or,  equivalently,  A^  (the  transpose  of  A^).  Th e  vector  r  is  understood 
to  have  scalar  components  r^,  r^,  and  r^s 


r  =  [r  r  r  ] 
x  y  z 


(2) 


while  r^  has  components: 


REFERENCE  COORDINATE  FRAMES:  (FIG  1) 


Figure  1#  Reference  Coordinate  Frames 


STABLE  REFERENCE  (XgYgZg) 


xQ  and  yQ  lie  in  the  local  horizontal  plane  with  positive  xQ  true  north 
and  positive  yQ  east  (Fig  2).  Positive  zQ  is  the  local  vertical- downward*  We 
assume  XgYgZg  is  an  inertial  reference  frame* 


/r 

Y0(EAST)  ZqIDOWN) 


Xq(NORTH) 


‘ 


Figure  2*  Stable  Reference  Frame 

SHIP  REFERENCE  (x  y^^ 

The  ship  reference  axes  (Fig  3)  are  the  body  axes  of  the  ship  used  as  the 
reference  for  measurement  of  the  roll  (  +  ),  pitch  (6),  and  yaw  (4>)  angles  of 
the  ship*  These  axes  correspond,  for  example ,  to  the  axes  of  the  MK  19  Gyro¬ 
compass  or  AN/WSN-5  Inertial  System*  The  axes  are  fixed  in  attitude  relative 
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to  the  ship  and  rotate  with  the  ship  relative  to  the  stable  reference 
(XqYqZq)*  Xj  is  the  roll  axis  of  the  ship  with  positive  forward,  is  the 
pitch  axis, positive  to  starboard,  and  is  the  yaw  axis  with  positive  down¬ 
ward. 


The  attitude  of  the  ship  reference  (x^y^)  relative  to  the  stable 
reference  (x  is  a  consequence  of  the  ordered  Euler  angle  rotations! 


(1)  ty  about  the  z-axis  (yaw  or  heading) 

(2)  0  about  the  y-axis  (pitch) 

(3)  ty  about  the  x-axis  (roll) 


The  orthogonal  transformation  from  the  stable  reference  ^xQyQZ0^  t0  tile 
ship  reference  (x^y^z^)  is: 


01 


C0 

Sty  C0 

-80 

CtyS0Sty 

StyS0  Sty 

C0  Sty 

—  8tyCty 

+CtyCty 

ctysOcty 

StyS0Cty 

C0Cty 

+stysty 

-Ctysty 

(4) 


where  c  and  s  denote  the  cosine  and  sine  functions* 


The  ship  reference  frame,  as  defined  above,  corresponds  to  the  reference 
frame  conventionally  used  for  attitude  reference  in  virtually  all  modern  tech¬ 
nical  publications,  ie,  positive  roll  and  yaw  motions  are  to  starboard  and 
positive  pitch  corresponds  to  a  bow-up  attitude.  OP  1700  (Standard  Fire 


Control  Symbols)  does  not  conform  to  this  convention,  but  instead  defines 
positive  roll  motion  to  port  and  positive  pitch  as  bow-down  attitude.  This 
report  will  continue  to  use  the  conventional  definitions.  The  modifications 
required  to  use  the  OP  1700  definitions  are  presented  in  the  Appendix. 

LAUNCHER  REFERENCE  (x^z^ 

The  vertical  launching  system,  when  installed,  is  nominally  aligned  with 
the  ship  reference  axeB  (x^y^z^).  In  fact,  however,  these  axes  are  generally 
not  used  directly  because  of  structural  obstructions.  Instead,  the  launching 
system  is  aligned  with  respect  to  some  launcher  reference  ^2^2*2^  was* 

in  turn,  previously  aligned  with  respect  to  the  ship  reference  (x^z^).  The 
transformation  represents  the  misalignment  between  the  ship  reference 
(XjYjEj)  and  the  launcher  reference  (x2y2z2*  an<i  is  a  fu*10**011  of  static  and 
dynamic  alignment  errors  due  to  errors  in  initial  alignment  and  subsequent 
structural  flexure • 

AUTOPILOT  ALIGNMENT  REFERENCE  (x^Z^) 


X3 


Figure  4.  Autopilot  Alignment  Reference 


The  autopilot  alignment  reference  axes  (x^y^z^)  (Fig  4)  represent  the 
nominal  (or  intended)  axes  of  the  autopilot ,  that  is,  the  autopilot  axes  when 
the  missile,  in  its  canister  and  cell,  has  been  aligned,  without  error,  with 
respect  to  the  launcher  reference  ^X2^2Z2^  *  X3  ro^  ^is  of  the  auto¬ 

pilot,  the  pitch  axis,  and  z^  the  yaw  axis.  Positive  x^  is  forward  in  the 
missile  and  positive  y^  is  to  starboard. 

The  configuration  of  the  vertical  launch  system  is  such  that,  with  the 
missile  and  its  canister  loaded  into  one  of  the  cells,  the  positive  x^  axis  is 
in  the  direction  of  negative  z^  and  positive  z^  is  either  45*  to  port  of 
positive  x^  (we  say  X  =*  45°)  or  45°  to  starboard  of  negative  x^  (we  say  X  * 
225°).  Positive  y^  completes  the  right-handed  triad. 

The  attitude  of  the  autopilot  alignment  reference  (x^y^z^  relative  to 
the  launcher  reference  ^X2^2Z2^  a  consecIuence  or^ere<^  Euler  angle 

rotations : 

( 1 )  90  °  about  the  y  axis 

(2)  X  (45°  or  225°)  about  the  x  axis 

The  orthogonal  transformation  from  the  launcher  reference  (*2^2Z2^  to 
autopilot  alignment  reference  (x^y^z^)  *s: 


0 


0 


A 


21* 


sx 

cx 


CX 

-sX 


0 

0 


(5) 


AUTOPILOT  REFERENCE  (x4y4z4) 

The  autopilot  reference  axes  (x4y4z4)  represent  the  actual  reference  axes 
of  the  autopilot  <x4-roll,  y4«pitch,  z4-yaw)  with  the  missile  and  its  canister 
loaded  into  a  cell.  The  transformation  M^4  then  represents  the  misalignment 
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error  of  the  autopilot  axes  relative  to  the  autopilot  alignment 

reference  l*2*3z^* 

COMMAND  REFERENCE  (*^5*5) 


BALLISTIC 

VECTOR 


Figure  5.  command  Reference 


The  command  reference  (x5y5z,-)  is  vised  as  an  attitude  control  reference 

by  the  autopilot  (Fig  5).  The  positive  axis  is  in  the  direction  of  the 

ballistic  vector.  Positive  x_  and  positive  ze  lie  in  a  vertical  plane  with 

5  o 

positive  x5  upwards,  completes  the  right-handed  triad. 

The  ballistic  vector  is  defined  by  an  azimuth  angle  A  measured  in  the 
horizontal  plane  from  true  north  and  an  elevation  angle  E,  the  angle  above  the 
horizontal  plane,  measured  in  the  vertical  plane.  Then  the  attitude  of  the 
command  reference  (*5y5z5)  relative  to  the  stable  reference  (x0yQz0)  is  a 
consequence  of  the  following  ordered  Euler  angle  rotations: 


(1)  90*  about  y  (reorientation  of  axes) 

(2)  -A  about  x  (azimuth) 

(3)  E  about  y  (elevation) 


The  orthogonal  transformation  from  the  stable  refetence 
cosmand  reference  (x^y^Zg)  is: 


A 


05 


~CASE 

-SA 

cAcE 


-sAsE 

cA 

sAcE 


-CE 

0 

-SE 


(6) 
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ATTITUDE  OF  COMMAND  REFERENCE  (XgYgZg) 

RELATIVE  TO  AUTOPILOT  REFERENCE  (x„y.zj 

4  4  4 


The  orthogonal  tr an format ion  a^5  (Fig  1)  describes  the  attitude  of  the 
command  reference  (x^y^z^)  relative  to  the  autopilot  reference  (x^y^z^).  A45 

is  computed  as  the  product  of  known  matrices: 


45 


=  A 


M 


M„ 


05  01  12  23  34 


(7) 


AQ1  and  aq5  are  computed  as  indicated  by  Eq  (4)  and  (6)*  A^  is  computed 
as  a  function  of  X  as  indicated  by  Eq  (5).  The  parameter  X  is  a  constant  for 
a  particular  cell  and  will  be  provided  (or  some  equivalent  parameter)  by  the 
Launcher  Control  Unit  (LCU)  following  cell  selection* 


The  source  of  the  misalignment  transformations ,  and  m^,  is  presently 
not  known ,  pending  results  of  current  studies  of  system  misalignment  errors. 
These  may  be  provided,  in  full  or  in  part,  by  the  LCU,  may  be  computed  in  the 
fire  control  computer  from  externally  provided  data,  or  may  be  produced  by 
some  external  subsystem  dedicated  to  misalignment  correction.  In  any  event, 
the  tranformations  will  be  provided  to  the  fire  control  computer  for  autopilot 
initialization . 


10 


tv 


PREDICTED  ATTITUDE  OF  COMMAND  REFERENCE  (x_y_z_) 

5  5  5 

RELATIVE  TO  AUTOPILOT  REFERENCE  (x^y Az A) 

4  4  4 

Let  the  vector  a  denote  the  angular  velocity  of  the  autopilot  reference 
(x^y^z^)  relative  to  the  stable  reference  (x^y^Zg)  and  let  8  represent  the 
angular  velocity  of  the  conwand  reference  axes  (x5y5z,.)  relative  to  the  stable 
reference  (x0yQz0). 


The  time  derivative  of  the  orthogonal  transformation  A4^  is  given  by: 


'45 


*45° 


(B> 


where  fl  is  the  skew- symmetric  matrix: 


0 

(Bz4  "  °z4) 

(0ly4 

By4 

(a.  -  *  ,) 

z4  z4 

0 

(Bx4  - 

ax4 

(0  ,  -  a  A) 
y4  y4 

(ax4  '  ®X4) 

0 

(9) 


The  angular  velocity  vector  a,  in  the  absence  of  dynamic  flexure,  is 

identical  to  the  ship's  angular  velocity  vector  w,  which  can  be  computed  from 

•  •  • 

ship's  roll,  pitch,  and  yaw  rates  (♦,  0,  respectively).  Then,  assuming  no 
dynamic  flexure,  we  compute  a  in  ship  reference  (x^y^z^)  coordinates: 


•  • 

«x1  (10) 

•  • 

*  tc6s4  +  0c4 

•  • 

a  *  «  ♦c&c*  -  0s4 

z  1 

The  angular  velocity  0  must  be  computed  from  the  dynamics  of  the  command 

reference  frame  (x  y  z  ),  Specifically,  the  azimuth  and  elevation  rates,  a 
•  5  5  5  ^ 

and  E,  respectively,  must  be  computed.  Then  0,  in  stable  reference  coordi¬ 
nates  <*0y0z0),  *•: 
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-ESA 


6 

a 

a 


xo 

yO 

zO 


EcA 

-A 


(ID 


The  differential  equation  [Eq  (8)]  provides  the  basis  for  prediction  or 

update  of  the  transformation  A„c.  If  we  wish  to  predict  from  time  t  to  t  +  T, 

45 

we  can  expand  A^s  in  a  Taylor  series  and  use  the  first  two  terms  as  a  first- 
order  approximation: 


A45(t 


+  T)  %A45<t) 


TA45(t) 


(12) 


Other ,  more  sophisticated,  approximations  are  common  in  the  literature  and  can 
be  provided,  if  required. 


LEAST  SQUARES  ORTHOGONAL I Z AT I ON  OF  NONORTHOGONAL  MATRICES 

Because  of  numerical  errors  in  digital  computations  and  slightly  nonor- 
thogonal  reference  axes,  algorithms  for  the  matrix  equations  described  herein 
generally  produce  slightly  nonorthogonal  matrices*  The  nonorthogonality  can, 
in  some  instances,  produce  adverse  effects*  Thus  it  is  common  ia  such  compu¬ 
tations  to  include  some  subroutine  to  orthogonal ire  the  computed  transforma¬ 
tions*  A  first-order,  least- squares  algorithm  for  orthogonalization  is  de¬ 
scribed  below. 

Let  A  represent  a  computed  transformation  matrix  which  is  "near-ortho¬ 
gonal."  The  least  squares  algorithms 

^  T  —  1  /2 

A  -  A  (A  A)  (13) 

provides  an  orthogonal  transformation  A  which  is  nearest  to  A  in  a  least 
squares  sense.  That  is,  the  algorithm  minimizes  the  error  measure  e: 

e  -  TR[(A-A)T(A-A)]  (14) 

(where  TR  indicates  the  matrix  trace  function)  subject  to  the  constraint  that 
A  be  orthogonal: 

AAT  -  I  -  0  (15) 

Equation  (13)  is  computationally  difficult  because  the  square  root  func¬ 
tion  requires  computation  of  eigenvalues*  In  practice,  a  first-order  approxi¬ 
mation  is  usually  sufficient: 

A  -  A  +  1/2  A  (I  -  ATA)  (16) 

Other,  more  sophisticated,  orthogonalization  algorithms  are  common  in  the 
literature* 
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VELOCITY  OF  THE  LAUNCH  POINT  REFERENCE  RELATIVE  TO  THE  MOVING  AIR  MASS 


We  define  the  following  vectors  (see  Fig  6): 


(1)  v  =  ship's  inertial  velocity  measured  at  some  reference  point  A  in 
the  ship. 

(2)  u  *  inertial  velocity  of  the  launch  point  reference  B. 

(3)  r  *  displacement  vector  from  point  A  (ship's  velocity  reference)  to 
point  B  (launch  point  reference). 

(4)  a)  »  angular  velocity  of  the  ship  relative  to  the  stable  reference 

(xoyozo>* 

(5)  w  *  inertial  wind  velocity. 

Since  we  have  assumed  that  the  stable  reference  (xqY02o^  is  an  inertial 
reference,  all  velocities  and  angular  rates  are  relative  to  that  reference. 

Autopilot  initialization  requires  the  velocity  of  the  launch  point 
reference  (B)  relative  to  the  moving  air  mass  in  autopilot  reference  coordi¬ 
nates  (x^y^z^) ,  that  is,  the  vector  quantity  -  w^. 

The  vectors  v  (ship's  velocity)  and  w  (wind  velocity)  are  measurements  in 
stable  reference  coordinates  (XqYq^q)  provided  to  the  fire  control  system. 

The  vector  r  is  provided  by  the  LCU  when  a  particular  cell  has  been  selected. 
We  assume  that  r  is  provided  in  ship  reference  coordinates  (x^y^z^). 
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The  angular  velocity  vector  «  may  be  computed  in  ship  reference  coordi¬ 
nates  (XjYjZj)  from  ship  roll,  pitch,  and  yaw  rates  by  means  of  Eq  (10): 

u>  -  -  ♦sO  +  4 
xl 

b)  *  tc6s+  +  8c$ 

y '  •  • 

oi  -  ♦c&c*  -  8s^ 


Then: 


W4  '  W4  *  V4  +  (w4  X  V  "  W4 


M34  A23  M12lA01<V0  ”  W0)  +  (“l  X  ri ^ 
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PREDICTED  VELOCITY  OF  THE  LAUNCH  POINT  REFERENCE  RELATIVE 
TO  THE  MOVING  AIR  MASS 


A  simple  linear  extrapolation  algorithm  can  be  used  to  provide  a  first- 
order  estimate  of  launch  point  reference  velocity  in  the  moving  air  mass  at 
seme  future  time. 

To  simplify  notation,  let: 


Then,  a  first-order  estimate  of  x  at  time  t  +  T^  can  be  determined  from 
computed  values  of  x  at  times  t  and  t  - 

x  (t  +  T,)  fe  x(t)  +  Tt 

Other,  more  complex  nonlinear  extrapolation  algorithms  may  be  used,  if  this 
simple  linear  extrapolation  is  inadequate. 


x(t)  -  x{  t-T^  ) 


(20) 
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APPENDIX 

MODIFIED  EQUATIONS  FOR  OP  1700  DEFINITIONS 


OP  1700  (Standard  Fire  Control  Symbols)  defines  own-ship  yaw  motion  as 
positive  to  starboard ,  roll  motion  as  positive  to  port,  and  positive  pitch  as 
bow-down  attitude.  Using  these  definitions.  Fig  A-1  illustrates  the  ship 
reference  frame  (x^y^^).  The  attitude  of  the  ship  reference  (x^y^z^)  rela¬ 
tive  to  the  stable  reference  (xQy0z0)  *s  a  conse<Juence  °f  the  following 
ordered  Euler  angle  rotations : 

(1)  180°  about  the  z-axis  (reorient  axes) 

(2)  ^  about  the  z-axis  (yaw) 

(3)  0  about  the  y-axis  (pitch) 

(4)  ♦  about  the  x-axis  (roll) 

Then  the  orthogonal  transformation  from  the  stable  reference  (x^y^z^)  to  the 
ship  reference  is: 


-c4»c6 

-s^c6 

-se 

-d|>S0S$ 

-s4»s0s$ 

+C0S$ 

+  S1|>C$ 

-Cl>C* 

-C^S0C$ 

-S^S0C$ 

+C0C$ 

-s^s$ 

The  launcher  reference  frame  an<*  reference  frame  (x^y^z^)  are 

assumed  to  be  nominally  aligned.  Thus  a  change  in  orientation  of  the  ship 
reference  (x^y^)  requires  a  corresponding  reorientation  of  the  launcher 
reference  (x2y2z2*#  Therefore  the  transformation  A ^  will  change,  since  the 
launcher  reference  <X2Y2Z2*  reoriente<*  without  a  corresponding  reorienta¬ 
tion  of  the  autopilot  alignment  reference  (XjYjZj)* 


The  transformation  from  the  launcher  reference  (X2Y2*2*  to  the  autoPilot 
alignment  reference  is  a  consequence  of  the  following  ordered  Euler  angle 
rotations  ( see  Fig  A-2 ) : 
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n> 

(2) 

(3) 


180°  about  the  z-axis 

90°  about  the  y-axis 

X  (45°  or  225  •)  about  the  x-axis 


Then  the  transformation  A^3  is 


given  by: 


A23 


a 

-sX 


0 

-cX 


-cA  sX 


0 


(A-2) 


No  other  modifications  to  the  equations  in  the  body  of  this  report  are  neces¬ 
sary,  when  the  OP  1700  definitions  of  own-ship  roll,  pitch,  and  yaw  are  used* 


To  summarize:  When  using  the  OP  1700  definitions  in  place  of  the  conven¬ 
tional  definitions,  replace  Pig  3  and  4  with  Pig  A-1  and  A-2,  respectively, 
and  replace  Eq  (4)  ^nd  (5)  with  Eq  (A-1)  and  (A-2),  respectively. 


Figure  A-1.  Ship  Reference  Frame  (OP  1700  Standard) 
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